read_as_df <- function(path, col_name) {
df <- read.csv(path, header = FALSE) %>% data.frame()
names(df) <- col_name
return(df)
}
points <- read.csv("data/cpp_astar_path.csv")
points_pick_reg <- read.csv("data/cpp_reg_simplified.csv")
three_d_map <- read.csv("data/status.csv")
curve_points <- read.csv("data/cpp_smoothCurv.csv")
head(points)
## x y z
## 1 1 1 1
## 2 2 2 2
## 3 3 3 3
## 4 4 4 4
## 5 5 5 5
## 6 6 6 6
head(points_pick_reg)
## x y z
## 1 1 1 1
## 2 35 35 35
## 3 39 38 39
## 4 43 38 43
## 5 47 38 47
## 6 50 39 50
Following section prints out the path as lines and no map information is demonstrated.
Demonstration of path from astar:
print_points(points)
Demonstration of path after regression based selector:
print_points(points_pick_reg)
Demonstration of path of smooth curve:
print_points(curve_points)
Following section prints out the path and blocked areas. Blocked areas are in the color of grey (#696969) Searched areas are in the color of sky-blue (#66ccff) path are in the color of red (#ff0000), the width of the path is extended to 10.
Map and non-smoothed path:
print_3D_model_path(three_d_map, points_pick_reg)
Map and smoothed path:
print_3D_model_path(three_d_map, curve_points)